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(57) Abstract: The invention relates to a device for 
monitoring the integrity of position- and speed-related 
information supplied by a hybrid system comprising 
an inertial unit INS (1) which is reset with the aid of 
a GNSS satellite positioning receiver (2) by means of 
a Kalman hybridisation filter (3) using a reset gain K 
and an evolution matrix R The inventive device includes 
a satellite problem-detector circuit (4) comprising: a 
predictor/estimator filter bank (40i) which uses gain 
K and evolution matrix F of the Kalman hybridisation 
filter (3), each filter observing the deviation between (i) 
the positioning point which is obtained from N visible 
satellites, in the form of geographical co-ordinates, and 
which is delivered by the GNSS receiver (2) and (ii) 
one of the positioning points P(N-i)/i, also in the form of 
geographical co-ordinates, which are delivered by the 
same GNSS receiver (2) and which are obtained using 
N-1 of N visible satellites for resolution; and test circuits 
(41i) which compare the states of the predictor/estimator 
filters (40i) to the variances thereof and which detect 
a satellite failure when a test is positive, said deviation 
being greater than a detection threshold. 

(57) Abrege : Le dispositif est destine a la surveillance 

de I'integrite des informations de position et de vitesse 
foumies par un systeme hybride compose d'une centrale 
inertielle INS (1) recalee a I'aide d'un recepteur de posi- 
tionnement par satellites GNSS (2) au moyen d'un filtre 
de Kalman d'hybridation (3) utilisant un gain 
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de recalage K et une matrice d'evolution F. H comporte un circuit (4) detecteur de probleme satellite comportant un banc de filtres 
predicteurs-estimateurs (40i) utilisant le gain K et la matrice d'evolution F du filtre de Kalman d'hybridation (3), observant chacun 
I'ecart entre le point de positionnement obtenu a partir des N satellites visibles, en coordonnees geographiques, delivre par le recepteur 
GNSS (2) et Tun des points de positionnement P(N-i)/i, egalement en coordonnees geographiques, delivres par ce meme recepteur 
GNSS (2) obtenu en utilisant N-1 des N satellites visibles pour la resolution, et des circuits de test (41i) comparant les etats des filtres 
predicteurs-estimateurs (40i) a leurs variances et detectant une panne satellite lorsqu'un test est positif, I'ecart trouve etant superieur 
a un seuil de detection. 
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DISPOSITIF DE SURVEILLANCE DE UlNTEGRiTE DES INFORMATIONS 
DELIVREES PAR UN SYSTEME HYBRIDE INS/GNSS 

L'invention est relative a la surveillance de l*integrite des 
6 informations de position et de vitesse issues d'une hybridation entre une 
centrale inertielle et un recepteur de positionnement par satellites. Elle 
concerne plus precisement un equipement de navigation connu dans la 
technique sous le nom de systeme INS/GNSS (de I'anglo-saxon "Inertial 
Navigation System" et "Global Navigation Satellite System") hybride en 
10 boucle fermde, Thybridation dtant dite lache car reallsde en axes 
gdographiques. 

Une centrale inertielle est constituee d'un ensemble de capteurs 
inertiels (capteurs gyrometriques et capteurs accelerometriques) associe a 
une electronique de traitement Une plate-forme de calcul, appelee plate- 

15 forme virtuelle PFV, delivre alors les informations de vitesse et de position du 
porteur dans un referentiel precis (souvent note TGL, Triedre Geographique 
Local). La plate-forme virtuelle PFV permet la projection et Tintegration des 
donnees issues des capteurs inertiels. La centrale inertielle foumit des 
informations precises a court terme mais derivant sur le long tenme (sous 

20 Tinfluence des defauts capteurs). La maTtrise des defauts capteurs 
represente une proportion tres importante du cout de la centrale inertielle. 

Un recepteur de positionnement par satellites foumit des 
informations de position et de vitesse du porteur par triangulation a partir des 
positions de satellites defilants visibles du porteur. Les informations fournies 

25 peuvent etre momentanement indisponibles car le recepteur doit avoir en vue 
directe un minimum de quatre satellites du systeme de positionnement pour 
pouvoir faire un point. Elles sont en outre d'une precision variable, dependant 
de la geometrie de la constellation a la base de la triangulation, et bruitees 
car reposant sur la reception de signaux de tres faibles niveaux provenant de 

30 satellites ^loign^ ayant une falble puissance d'emission. Mais elles ne 
souffrent pas de derive a long terme, les positions des satellites defilants sur 
leurs orbites etant connues avec precision sur le long terme. Les bruits et les 
erreurs peuvent etre lies aux systemes satellitaires, au recepteur ou a la 
propagation du signal entre I'emetteur satellitaire et le recepteur de signaux 

35 GNSS. En outre, les donnees satellites peuvent etre erronees par suite de 
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pannes affectant les satellites. Ces donnees non integres doivent alors etre 
reperees pour ne pas fausser la position issue du recepteur GNSS. 

Pour prevenir les pannes satellites et assurer Tintegrite des 
mesures GNSS, II est connu d'equiper un recepteur de positionnement par 
6 satellites d'un systeme d'estimation de precision et de disponibilite dit RAIM 
(de ranglo-saxon "Receiver Autononnous Integrity Monitoring") qui se base 
sur la geometrie de la constellation de satellites utilisSe lors de la 
triangulatlon et sur revolution previsible a court terme de cette geometrie 
deduite de la connaissance des trajectoires des satellites. Cependant, ce 
10 systeme, purement lie au systeme de localisation par satellites, n'est pas 
applicable a la surveillance d'un point de localisation issu d'un systeme 
hybride (INS/GNSS) et ne peut detector que certains types de pannes en un 
temps donne. 

L'hybridation consiste a combiner mathematiquement les 

15 informations de position et de vitesse fournies par la centrale inertielle et le 
recepteur de positionnement par satellites pour obtenir des informations de 
position et de vitesse en tirant avantage des deux systemes. Ainsi, la 
precision sur le positionnement foumi par le systeme GNSS permet de 
maTtriser la derive inertielle et les mesures inertielles peu bruitees permettent 

20 de filtrer le bruit sur les mesures du recepteur GNSS. Cette combinaison fait 
tres souvent appel a la technique.de filtrage de Kalman. 

Le filtrage de Kalman s'appuie sur les possibilites de modelisation 
de revolution de I'etat d'un systeme physique considere dans son 
environnement, au moyen d'une equation dite "d'6volution" (estimation a 

25 priori), et de modelisation de la relation de dependance existant entre les 
etats du systeme physique considere et les mesures par lesquelles II est 
pergu de Texterieur, au moyen d'une equation dite "d'observation" pour 
permettre un recalage des etats du filtre (estimation a posteriori). Dans un 
filtre de Kalman, la mesure effective ou "vecteur de mesure" permet de 

30 realiser une estimee a posteriori de Tetat du systeme qui soit optimale dans 
le sens ou elle minimise la covariance de Ferreur faite sur cette estimation. 
La partie estimateur du filtre genere des estimees a priori du vecteur d'etat 
du systeme en utilisant I'ecart constate entre le vecteur de mesure effectif et 
sa prediction a priori pour engendrer un terme correctif, appelS innovation. 
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Cette innovation est appliquee a I'estimee a priori du vecteur d'etat du 
systeme et conduit a I'obtention de I'estimee optimale a posteriori, 

Dans le cas d'un systeme INS/GNSS hybride, le flltre de Kalman 
regoit les points de position et de vitesse fournis par la centrale inertielle et le 
5 recepteur de posltionnement par satellites, modelise {'evolution des erreurs 
de la centrale inertielle et dSlivre I'estimee a posteriori de ces erreurs qui sert 
d corriger le point de posltionnement et de vitesse de la centrale inertielle. 

Uestimation des erreurs de position et de vitesse dues aux 
defauts des capteurs inertiels apparaissant en sortie de la plate-forme 

10 virtuelle PFV de la centrale inert:iel[e est realisee par le flltre de Kalman. La 
correction des erreurs par le biais de leur estimation faite par le flltre de 
Kalman peut alors se faire en entree de la plate-forme virtuelle PFV 
(architecture en boucle fermee) ou en sortie (architecture en boucle ouverte). 

Lorsque les defauts des capteurs de la centrale inertielle ne sent 

16 pas trop importanis, 11 n'est pas necessaire d'appliquer les corrections en 
entree de la plate-forme virtuelle PFV. La modelisation du systeme 
(linearisation des equations regissant I'evoiution du systeme), au sein du 
flltre reste valide. L'estimee a posteriori des erreurs de la centrale Inertielle 
calculee dans le flltre de Kalman n'est utilisee que pour I'elaboration de 

20 I'estimee optimale de la position et de la vitesse du porteur compte tenu des 
informations de position et de vitesse foumies par la centrale inertielle et par.. 
le recepteur GNSS. L'hybridation est alors dite en boucle ouverte. 

Lorsque les defauts inertiels sent trop importants la linearisation 
des equations regissant {'Evolution du modele inertiel Integra au sein du filtre 

25 de Kalman n'est plus valide. II est done imperatif d'appliquer les corrections a 
la plate-forme virtuelle PFV pour rester dans le domaine lineaire. L'estimee a 
posteriori des en-eurs la centrale Inertielle calculee dans le flltre de Kalman 
sert non seulement a I'elaboration de l'estimee optimale de la position et de 
la Vitesse du porteur mais aussi au recalage de la centrale inertielle au sein 

30 de la plate-forme virtuelle PFV. L'hybridation est alors dite en boucle fermee, 
L'hybridation peut egalement se faire en observant des 
informations GNSS de natures differentes. Soit on considere les position et 
Vitesse du porteur resolues par le recepteur GNSS. On parie alors 
d'hybridation lache. Soit on considere les informations extraites en amont par 

35 le recepteur GNSS que sent les pseudo-distances et les pseudo-vltesses 
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(grandeurs directement isssues de la mesure du temps de propagation et de 
Teffet Doppler des signaux emis par les satellites en direction du recepteur). 
On parle alors d'hybridation serree. 

Avec un systeme INS/GNSS en boucle fermee ou le point resolu 
5 par ie recepteur GNSS est utilise pour recaler les informations provenant de 
la centrale inertielle, 11 est necessaire de preter une attention particuliere aux 
defauts affectant les informations foumies par les satellites car le recepteur 
qui les regoit propagera ces delauts § la centrale inertielle en entraTnant un 
mauvais recalage de cette demiere. Le probleme se pose de fagon 

10 particulierement critique pour assurer I'integrite d'un point liybride INS/GPS. 

Une maniere connue de proceder a la surveillance de I'integrite 
d'un systeme hybride INS/GNSS en boucle fermee est decrite dans le brevet 
americain US 5,583,774, Elle consiste a espacer les recalages d'un temps 
suffisamment long (par exemple 30 minutes) pour qu'un detecteur a base de 

15 flltres de F^lman surveillant revolution des ecarts de mesures de pseudo- 
distance et de pseudo-vitesse par rapport au porteur de chaque satellite 
visible ait pu isoler les satellites defaiilants. 

Un autre precede connu pour surveiller Tintegrite d'un systeme 
hybride INS/GNSS est decrit dans le brevet americain US 5,923,286. I! 

20 consiste a utiliser un equipement RAIM pour autoriser ou non I'hybridation, 
Lorsque I'equipement RAIM signale une perte d'integrite^ I'hybridation est 
gelee et le point de position et de vitesse est foumi par la centrale INS en 
tenant compte de ses derives et biais mesurees juste avant la perte 
d'integrite. Pour que cela marche, il faut que la centrale inertielle n'ait pas et6 

25 polluee par Terreur de point commise par le recepteur GNSS, ce qui interdit 
de la recaler avec le recepteur GNSS. Le precede est done reserve 
uniquement au systeme hybrides INS/GNSS en boucle ouverte. 
> La presente invention a pour but une surveillance de I'integrite des 

informations de position et de vitesse d'un systeme hybride constitue d'une 

30 centrale inertielle recalee a I'aide d'un recepteur GNSS en utilisant la position 
et la Vitesse resolues du porteur issues du recepteur GNSS. 

Elle a pour objet un dispositif de surveillance de Tintegrite d'un 
systeme hybride constitue d'une centrale inertielle INS, d'un recepteur de 
positionnement par satellites GNSS operant a partir d'une constellation de N 

35 satellites vislbles et d'un filtre de Kalman d'hybridation ayant un vecteur 
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d'etats correspondants aux erreurs du systeme hybride, en particulier, les 
erreurs de biais et de derive residuelles de la centrale inertielle INS, 
observant les ecarts entre les points de positionnement et de vitesse foumis, 
en coordonnees geographiques, par la centrale inertielle INS et par le 
5 recepteur GNSS, comportant une matrice d'evolution F modelisant revolution 
des erreurs du systeme hybride, une matrice d'observation H modelisant les 
relations liant le vecteur d'etats et les ecarts observes entre les positions et 
les vitesses delivrees par la centrale inertielle INS et le recepteur GNSS, et 
un gain K minimisant la covariance de I'erreur faite sur Testimation a 

10 posteriori des erreurs de position et de vitesse issues de la centrale 
inertielle, et delivrant une estimee a posteriori des erreurs du systeme 
hybride qui sett a recaier la centrale inertielle. Ce systeme de surveillance 
est remarquable en ce que le recepteur GNSS dellvre, en plus d'un point de 
position effectu^ a partir des N satellites de la constellation quil a en vue, N- 

15 1 points de position effectues a pari:ir de la constellation des N satellites 
visibles privee, a chaque fois, d'un satellite different et en ce qu'il comporte 
un circuit d^ecteur de probleme satellite comportant un banc de N filtres 
predicteurs-estimateurs de I'erreur induite par le satellite qui a et^ ote lors de 
la resolution d'un point a N-1 satellites, ayant le gain K et la matrice 

20 d'evolution F du filtre de kalman d'hybridation, observant chacun I'ecart entre 
le point de position, en coordonn6es geographiques, d^Iivre par le recepteur 
GNSS en observant les N satellites visibles et I'un des points de position, 
egalement en coordonnees geographiques, delivres par le recepteur GNSS 
en observant N-1 satellites visibles et des circuits de test comparant les etats 

25 des N filtres predicteurs-estimateurs a leurs variances et detectant une 
panne satellite torsque le test est positif, I'ecart trouve etant superieur a un 
seuil de detection. 

Avantageusement, les circuits de test ont des seuils de detection 
30 de panne satellite qui resultent de tests statistiques tenant compte de la 
covariance associee au type d'erreur de positionnement considere. 

Avantageusement, les circuits de test ont des seuils de detection 
de panne satellite qui resultent de tests statistiques tenant compte de la 
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cx)variance associee au type d'erreur de positionnement considere et qui 
sont fonction du taux de fausse alarme acceptable pour le test. 

Avantageusement, le systeme de surveillance comporte un circuit 
5 d'inhibition des recalages intercale entre la sortie du filtre de Kalman 
d'hybridation et une entree de recalage de la centrale inertielle, et active par 
un test positif de detection de probleme satellite. 

Avantageusement, les filtres predicteurs-estimateurs du circuit 
10 d^tecteur de probleme satellite (premier banc de filtre) ont tous la meme 
matrice d'observation. 

Avantageusement, le recepteur GNSS delivre en plus des points 
de position, en coordonnees geographiques, effectues a partir des N 

15 satellites visibles et ceux effectues a partir de N*1 satellites deduits de la 
constellation formee par les N satellites visibles en retirant § chaque fois un 
satellite visible different Nx(N-1)/2 points de position avec N-2 satellites 
deduits des N satellites visibles en retirant k chaque fois deux satellites 
visibles differents, et le systeme de surveillance comporte un circuit 

20 identificateur de satellite defaillant compose d'un deuxleme banc de Nx(N- 
1)/2 filtres de predicteurs-estimateurs d'ecarts de positionnement ayant le 
gain K et la matrice d'evolution F du filtre de Kalman d'hybridation, observant 
chacun I'ecart entre un point de position, en coordonnees geographiques, 
delivre par le recepteur GNSS a partir de N-1 satellites parmi les N visibles et 

25 Tun des points de positionnement delivres par le recepteur de 
positionnement par satellites a partir de N-2 satellites parmi les N visibles 
deduite de la constellation sp6clfique de (N-1 ) satellites visibles priv^e de Tun 
de ses satellites visibles, les filtres estimateurs-dStecteurs pouvant etre 
regroupes par families de N-2 elements en fonction de la constellation 

30 specifique de N-1 satellites visibles prise en compte, des circuits de test 
comparant les etats des Nx(N-1)/2 filtres predicteurs-estimateurs par rapport 
a leurs variances afin de detector une eventuelle anomalie et un circuit de 
traitement identifiant, en cas d'anomalie detectee, un satellite fautif comme 
etant le satellite exclu d'un point d n-1 satellites dont la famille de filtres 
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predicteurs-estimateurs est la seule a n'avoir aucun de ses elements 
detectant une anomalie 

Avantageusement, les filtres predicteurs-estimateurs du circuit 
5 identlficateur de satellite defaillant ont tous la meme matrice d'observation. 

Avantageusement, les filtres predicteurs-estimateurs du detecteur 
de probleme satellite et du circuit identlficateur de satellite defaillant ont tous 
la meme matrice d'observation. 

10 

D'autres caracteristiques et avantages de Tinvention ressortiront 
de la description ci-apres d'un mode de realisation donn6 a titre d'exemple. 
Cette description sera faite en regard du dessin dans lequel : 
15 - des figures 1 et 2 representent le schema de principe d'un 

systeme hybride de positionnement INS/GNSS de type lache 
en boucle fermee, la figure 1 detaillant la centrale inertielle et 
la figure 2 le filtre de Kalman, 

- une figure 3 repr§sente un systeme hybride de positionnement 
20 INS/GNSS pourvu d'un circuit detecteur de probleme satellite 

cpnforme a {'invention, 

- une figure 4 represente un systeme hybride de positionnement 

INS/GNSS pourvu d'un circuit detecteur de probleme satellites 
et d'un circuit d'identificateur de satellite fautif conforme a 
25 invention, et 

- une figure 5 detaille la constitution du circuit identlficateur de 

satellite fautif de la figure 4. 

La figure 1 montre I'architecture d'un systeme hybride de 
30 positionnement equipe d'une centrale inertielle 1 et d'un recepteur de 
positionnement par satellites GNSS 2, dit en boucle fermee et de type lache 
car il se sert des informations de position (latitude, longitude et altitude) et de 
Vitesse (vitesse nord, Vitesse est et vitesse verticale) resolues du porteur 
delivrees par le recepteur GNSS 2 pour le recalage de la centrale Inertielle 
35 INS1. 
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Comme montre, la centrale inertielle comporte un ensemble 10 de 
capteurs Inertiels (accelerometres et gyrometres) et de circuits de calcul, 
appeles plate forme virtuelle PFV, pour effectuer les calculs de position, 
attitude et vitesses sur les sorties des capteurs inertiels. La plate-forme 
5 virtuelle PFD comporte principalement un ensemble d'integrateurs 11 
operant sur les signaux Q des gyrometres afin d'en deduire Tattltude du 
porteur, un changeurde repdre 12 permettant, a partlrde la connaissance de 
Torientation du porteur (attitude) du porteur, d'exprimer dans un repere 
geographique lie a la terre, les accelerations acc mesurees par les 

10 accelerometres dans un repere lie au porteur et deux ensembles integrateurs 
successifs 13, 14 operant sur les composantes de I'acceleration selon le 
repere geographique pour en deduire les composantes de la vitesse du 
porteur par rapport au nord Vn, par rapport a Test Ve et par rapport a la 
verticale Vv ainsi que la position du porteur en latitude, longitude et altitude. 

15 Les capteurs inertiels souffrent de defauts Inherents a leur conception : des 
biais et des derives qui font que les informations de position et d'attitude 
delivrees par une centrale inertielle se degradent avec le temps de 
fonctionnement. La lutte centre ces defauts est couteuse, ainsi 11 existe 
differentes classes de centrale inertielle en fonction des tolerances de biais 

20 et de derives acceptees. 

Le recepteur GNSS 2 est, par exemple un recepteur, GPS. II 
mesure les pseudo-distances et pseudo-vitesses du porteur par rapport a au 
moins quatre satellites visibles du porteur du systeme hybride de 
positionnement et resout, par triangulation, la position du porteur en latitude, 

25 longitude et altitude ainsi que les composantes de sa vitesse par rapport au 
nord Vn, par rapport a Test Ve et par rapport a la verticale Vv. II ne sera pas 
detains plus avant car il est bien connu de I'homme du metier et largement 
decrit dans la litterature ou de nombreux ouvrages lui ont ete consacres, par 
exemple le livre de Elliot D, KAPLAN intitule "Understanding GPS Principles 

30 and Applications" paru chez Artech House Publishers ISBN 0-89006-793-7. 
Les informations de position et de vitesse delivrees par un recepteur GNSS 
ne souffrent pas de derive puisqu'elles proviennent de mesures instantanees 
des eloignements et vitesses d'eloignement de satellites dont les orbites et 
les positions sur leurs orbites sent connues a long terme. Par centre, elles 

35 souffrent d'indlsponibilites, lorsque qu'il n'y a pas un minimum de quatre 
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satellites visibles. Elles sont bmitees car elles proviennent du traitement de 
signaux regus qui sont de tres faibles niveaux d'energie en raison de la 
distance d'eloignennent des satellites et de leurs faibles puissances 
d'emission et qui peuvent avoir ete corrompus en cours de transmission 
5 (rencontre de particules chargees entre le satellite et le recepteur). Leur 
fiabillte depend de celle des infonnations transmises par les satellites. 

Par rapport au recepteur GNSS, la centrale inertielle a I'avantage 
de ne pas faire appel a la collaboration d'equipements exterieurs au porteur 
et done de ne pas etre aussi sensible a Texterieur. Uintegrite et la 

10 disponibilite des informations inertielles etant bien meilleures, la centrale 
inertielle conserve tout son interet. Pour lutter centre sa derive et ses biais 
autrement que par des mesures couteuses prises au niveau de ses capteurs 
inertiels, il a ete propose de la recaler periodiquement au moyen du point de 
position et de vitesse foumi par un recepteur GNSS, apres un filtrage 

15 antibruit. 

Ce recalage se fait au moyen d'un filtre de Kalman 3 dit 
d'hybridation montre de maniere plus detaillee a la figure 2. 

Un filtre de l^lman permet d'obtenir une estimation de I'etat a 
posteriori d'un systeme, optimale dans le sens ou la covariance de I'erreur 
20 faite sur cette estimation a posteriori est minimale (on parte aussi 
d'estimation optimale au sens des moindres carres), IJ se base sur une 
modeiisation de revolution du systeme et sur une modelisation de la relation 
existant entre la mesure et I'etat du systeme. 

Dans sa plus grande generalite, la modelisation de revolution de 
25 I'etat du systeme est definie par une ^uation differentielle vectorielle 
linearisee au premier ordre qui s'exprime, apres discretisation du modele 
continu, par une Equation d'Svolution de la forme: 

X etant le vecteur d'etat de dimension p, u un vecteur de controle, Fk la 
30 matrice d'evolution definissant la relation entre le vecteur d'etat a I'etape K et 
le vecteur d'etat a I'etape K+1 en I'absence de vecteur de controle et de bruit 
de fonctionnement, Lk une matrice definissant la relation entre le vecteur de 
controle et le vecteur d'etat au cours d'une meme etape et wk un bruit de 
fonctionnement au cours d'une etape, suppose blanc et gaussien a valeur 
35 moyenne nulle. 
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La modelisation de la relation existant entre la mesure et I'etat du 
systeme est definie par une autre equation differentielle du premier ordre qui 
s'exprime, apres discretisation du modele continu, par une equation 
d'observation de la forme: 

z etant le vecteur de mesure (grandeurs du systemes physiquement 
observables) de dimension m, Hk la matrice d'observation dSfinlssant la 
relation entre le vecteur de mesure et le vecteur d'etat au cours d'une meme 
etape et vk un bruit de mesure au cours d'une etape suppose bianc et 

10 gaussien a valeur moyenne nulle. 

Le flltre de Kalman montre a ia figure 2 ne comporte pas de 
vecteur de controle et done pas de matrice Lk- II est recursif et repose sur la 
determination d'une estimation a priori St^,^^^ du vecteur d'etat du systeme a 
r^tape K a partir de la connaissance a posteriori du vecteur d'etat du 

16 systeme ^ I'etape precedente K-1 et de I'application a I'estimee a 

priori x^fK-i d'"" terme comecteur dependant de Tecart constate entre le 
vecteur mesure constats au cours de cette etape K et son estimee a 
priori deduite de I'estimation a priori Xj^fK_^ du vecteur d'etat. 

L'estimee a priori du vecteur de mesure a I'etape K est 

20 determinee par application des equations d'evolution et d'observation a 
I'estimee a posteriori du vecteur d'etat correspondant a I'etape K-1 

precedente. Cette operation est illustree sur la figure 2 par la presence d'une 
boucle de retroaction constituee d'un circuit k retard 30 et de deux filtres 31, 
32. 

25 Le circuit a retard 30 connecte en sortie du flltre de Kalman 

permet de memoriser I'estimee a posteriori ;cj^.j;^_i du vecteur d'etat 
disponible a la sortie du filtre de Kalman au cours de I'etape precedente K-1 . 

Le filtre 31 permet, par mise en oeuvre de I'equation d'evolution, 
I'obtention de I'estimee a priori Xj^f^.-^^ du vecteur d'etat a I'etape K, a partir de 

30 I'estimee a posteriori x^^^^f^.^ du vecteur d'etat du systeme a Tetape 
precedente K-1 . Sa fonction de transfert est definie par la matrice de 
{'equation d'evolution. 

Cette estimee a priori x^f^^^ du vecteur d'etat a I'etape K est 
ensuite utilisee pour obtenir, au moyen d'un deuxieme filtre 32, I'estimee a 

35 priori z^fjs:^^ du vecteur de mesure a I'etape K par application de l'6quation 
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d'observation, Ce deuxieme filtre 32 a, pour ce faire, une fonction de transfert 
definie par la matrice de Tequation d'observation. 

L'estimee a priori z^f^_^ du vecteur de mesure a i'etape K obtenue 
dans la boucie de retroaction est appliquee, en entree du filtre de Kalman, a 
5 un circuit soustracteur 33 qui regoit par ailleurs le vecteur de mesure 
eifectivement mesure au cours de i'etape K et qui delivre un vecteur d'erreur 
rk:' egalement appeie innovation, attestant de I'erreur commise lors de 
■'estimation a priori. Ce vecteur d'erreur est transforms par un troisieme 
filtre 34 en un vecteur de correction. Ce vecteur de correction est additionne 
10 par un deuxieme sommateur 35 a l'estimee a priori x^^^^-^ du vecteur d'etat 
pour l'6tape K issue du premier filtre 31 , pour obtenir l'estimee a posteriori 
^KfK vecteur d'etat qui constitue la sortie du filtre de Kalman. 

Le troisieme filtre 34, qui foumit le terme con"ectif, est connu sous 
le nom de filtre de gain de recalage. II a une fonction de transfert definie par 
15 une matrice determines de fagon a minimiser la covariance de I'erreur 
faite sur I'estimation a posteriori. 

Kalman a montre que la matrice de gain optimal Kg- pouvait etre 
detemnin^e par une methods recursive a partir des equations: 

- de la matrice de covariance de l'estimee a priori du vecteur 
20 d'etat 

- de definition de la matrice de gain elle-meme 

-de mise a jour de la matrice de covariance de l'estimee a 
25 posteriori du vecteur d'etat 

Pk/K ~{^~ ^K^K )^/JC-l 

P etant la matrice de covariance du vecteur d'etat, soit estimee a priori pour 
i'etape K a partir de I'etape K-1 si P est affecte de I'indice K/K-1 , soit estimee 
a posteriori si P est afPecte de I'indice K-1 /K-1 , 

30 R etant la matrice de covariance des bruits d'observation , 

Q etant la matrice de covariance des bruits d'etat (ou de fonctionnement) v^: - 
A I'initialisation, la matrice de covariance du vecteur d'etat et le 
vecteur d'etat sont pris egaux a leurs estimees les plus vraisemblables. Au 
pire, la matrice de covariance est une matrice diagonale avec des termes 

35 infinis ou tres grands (de fagon a avoir des ecarts-type tres grands devant le 
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domaine dans lequel le vecteur d'etat est susceptible d'evoluer) et I'estimee 
du vecteur d'etat le vecteur nul, lorsque Ton n'a aucune idee sur les valeurs 
inltiales. 

En pratique, le gain de correction d'un filtre de Kalman est 
6 "proportlonner" d I'incertltude sur Testimation a priori de Tetat du systeme et 
"inversement proportionnel" a I'incertitude sur la mesure. Si la mesure est 
tres incertaine et I'estimation de I'etat du systeme relatlvement precise, rScart 
constate est principalement dQ au bruit de mesure et la correction qui en 
decoule doit etre faibie. Au contraire, si Tincertitude sur la mesure est faible 

10 et celle sur ['estimation de I'etat du systeme grande, Tecart constate est tres 
representatif de I'erreur d'estimation et doit conduire a une correction forte. 
C'est le comportement vers lequel on tend avec le filtre de Kalman. 

En resume, un filtre de Kalman sans vecteur de controle est defini 
par une matrice Fk correspondant a I'equation d'6volution definissant 

15 revolution du vecteur d'etat du systeme physique modelise, une matrice Hk 
correspondant a I'equation d'observation definissant les relations permettant 
de passer du vecteur d'etat au vecteur de mesure et une matrice de gain Kk 
mise jour a I'aide d'un processus iteratif mettant en jeu la matrice de 
covariance du vecteur d'etat P elle-meme mise a jour au cours du processus 

20 iteratif et des matrices de covariance Qk et Rk des bruits d'etat et de mesure. 

Le filtre de Kalman 3 opere au niveau des hearts constates entre 
deux versions des informations de meme type provenant I'une, de la centrale 
inertielle INS 1 et I'autre, du recepteur GNSS 2, car cela permet de travailler 
sur des variables ayant des domaines de variation plus restreinis sur 

25 lesquels I'approximation lineaire peut etre utilisee pour simplifier les 
equations de modelisation et d'evolution (on parie alors de filtre aux erreurs). 

Dans ce cadre, Tequation d'evolution du filtre de Kalman modelise 
revolution previsible des erreurs sur le systeme hybride lies aux residus des 
defauts capteurs inertiels non estimes et a la mecanisation de la plate forme 

30 inertielle (ici boucle fermee) de la centrale inertielle 1 qu'il deduit des 
differences constatees entre la prevision d'ecart qu'il fait et les ecarts 
effectivement mesures entre la position et la Vitesse issues de la centrale 
inertielle et du recepteur GNSS. Elle est determinee par la matrice F dont la 
definition est fonction du mouvement du porteur, c'est-a-dire des parametres 

35 de vol dans le cas oD le porteur equipe du systeme hybride de 
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positionnement est un aeronef. La definition des differentes versions de cette 
matrice F en fonction des parametres du mouvement du porteur sort du 
domaine de la presente invention. Elle ne sera pas detaillee dans la suite car 
elie est bien connue de Thonnme du metier specialise dans le donnaine de 
5 I'inertie. 

Les residus x^^^g^des erreurs du systeme hybride estinnes a 
posteriori par le filtre de Kalman d'hybridation 3 sont utilises pour le recalage 
de la centrale inertielle INS 1 (boucle fermee). Les informations inertielles 
INS 1 etant regulierement recalees, les points de position et de vitesse 
10 hybrides sont supposes plus fiables a condition que les mesures GNSS 
soient integres. 

Pour resumer, le traitement effectue par le filtre de Kalman 
d'hybridation se divise en trois temps : 

Propagation du vecteur d'etat et de la matrice de variance-covariance 
15 associee 

^K+l/K - ^K-^KfK-^K Qk 

Recalage du vecteur d'etat et de la matrice de variance-covariance a 
Taide du gain Kk+i 

/K+1 ~ -^K-hl /K ~ ^K+\ -^K+l '-^K+l !K 

Application des corrections issues du filtre de Kalman 
d'hybridation a la centrale inertielle 

25 COR_FK^p^^-X^,^ 

La matrice d'observation Hk+i permet Tobservation des differences 
entre les positions et vitesses issues de la plate-forme virtuelle PFV et les 
positions et vitesses GNSS rdsolues. La matrice d'evolution Fk+i est calcul^e 
en utilisant les donnees de la plate-forme virtuelle PFV corrigees par le filtre 

30 de Kalman et permet la propagation de I'etat et de la matrice de variance- 
covariance associee. 

Le probleme rencontre avec les systemes hybrides de 
positionnement INS/GNSS en boucle fermee est le risque de voir les 
operations de recalage propager a la centrale inertielle 1 les erreurs de 

35 position et de vitesse commises par le recepteur GNSS 2 en raison 
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d'informations defectueuses !ui parvenant d'un ou plusieurs satellites 
defaillants (mauvaises corrections appliquees par le filtre de Kalman a la 
plate-forme virtuelle PFV, mauvaise estimation des defauts inertiels). 
Uintegrite du systeme hybride de positionnement INS/GNSS en boucle 
fermee est alors difficile a assurer. 

La figure 3 illustre ie schema d'un systeme hybride INS/GNSS en 
boucle fermee equips d'un detecteur de probleme satellite operant a partir 
des points de position, en coordonnees geographiques, effectues par le 
recepteur GNSS 2 avec tous les satellites visibles supposes au nombre de N 
et avec tous les satellites visibles moins Tun d'entre eux, le satellite visible 
ecarte etant Tun quelconque d'entre eux. 

Le detecteur de probleme satellite 4 comporte un banc de N filtres 
predicteurs-estimateurs 40i, 402,---, 40i,-.-,40N associe a un banc de circuits 
de test 41 1, 412,---, 41i,...,4lN controlant, par un circuit inhibiteur 5 intercale a 
la sortie du filtre de Kalman d'hybridation 3, la possibilite d*un recalage de la 
centrale inertielle 1 . 

Les filtres predicteurs-estimateurs 40i, 402,..., 40i,...,40N 
fonctionnent en boucle ouverte. 

Le vecteur d'etat du ieme filtre predicteur-estimateur 40iest 
compost des erreurs par rapport au vecteur d'etat du filtre de Kalman 
d'hybridation induitqs par la non prise en compte dans le recepteur GNSS 2 
des informations donnees par le ieme satellite visible et meme plus 
generalement par rapport a des mesures faites par d'autres equipements de 
navigation comme un altimetre barometrique ou un anemometre. 



erreurs attitude _ par _ rapport _ FK 
erreurs _ Vitesse _ par _ rapport _ FK 
, erreurs _ position _ par _ rapportFK 
erreurs _ biais _ accelero _ par _ rapport _ FK 
erreurs _ derives gyro _ par _ rapprot FK 
erreurs _ baro _ par _ rapport _ FK 
erreurs _anemo _par _rapport _FK 



Err* = 
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Les matrices d'evolution Fk des differents filtres predicteurs- 
estimateurs 40i, 402,.--. 40b...,40N sont identiques a celle Fk du filtre de 
Kalman d'hybridation 3 : 

^rrjr^uK = Fk^i -^^k/k (1 ) 

5 La mesure Z' d'un ieme filtre predicteur-estimateur 40i est 

constituee de Tecart entre la position, en coordonnees geographiques 
(latitude, longitude et altitude), resultant du point de positionnement P^^^^ 
effectue par le recepteur GNSS 2 en tenant compte de tous les N satellites 
visibles et la position, en coordonnees geographiques, resultant du point de 

10 positionnement P(jyr_i)/f effectue par le recepteur GNSS 2 en ecariant les 
informations envoyees par ie ieme satellite : 



Z' = 



Ay 

Az' 



15 Les matrices H d'observation des differents filtres predicteurs- 

estlmateurs 40 1, 402,..., 40i,...,40N sont toutes Identiques et correspondent h 
I'equatlon d'observation permettant de passer du vecteur d'etat Err^ au 
vecteur de mesure . 

Les gains des differents filtres predicteurs-estimateurs"40i, 4O2,..., 

20 40i,...,40N sont tous pris egaux a celui K du filtre de Kalman d'hybrldation 3 
de fagon que le recalage sur les mesures z' qu'ils resolvent se passe comme 
le recalage du filtre de Kalman d'hybridation 3. 

Compte tenu de ces choix, les recalages des vecteurs d'etat Err^ 
des filtres predicteurs-estimateurs 40i, 4O2,..., 40j,...,40N repondent a la 

25 relation : 

-^-^ir+i/ic+i " ^^K+UK + ^K+i -(^iir+i' ~ ^ k+i -^^k+uk ) (2) ' 

Pour detecter la d^faillance de Tun au molns des N satellites 
visibles par le recepteur de positionnement GNSS 2, on effectue des tests 
statistiques sur les vecteurs d'etat J?rr^ disponlbles en sortie des differents 
30 filtres predicteurs-estimateurs 40i, 4O2,-.., 40[,...,40n au moyen du banc des 
circuits de test 41 1, 4I2,..., 41i,,..,4lN- Ces circuit de test realisent des tests 
statistiques consistant a admettre une panne de satellite si, pour i allant de 1 
au nombre N de satellites visibles, Tune des deux inegalites sur les erreurs 
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de position des filtres predicleurs-estimateurs 40i, 4O2,..-, 40i,-.,40N 
suivantes est verifiee : 

[Err^^yjg; {err _ latj -Err^^y^^ {err _lat)\> K _ seuil *' .K seuiLCOV _ Err^^yj^ {err _ lat ) 
5 OU 

[Brrj.^j/^ {err _ lotif -Err^^^^ {err _ lon)\ > K_ seuil* _ seuiLCOV _ Err^^^^ {err _ Ion) 

La variable K_seuil contrdle indirectement la valeur de I'erreur 
radiaie acceptable. Elle est choisie en fonction du taux recherche de fausse 
10 alarme. Pour une probabilite de fausse alarme de 1 0~^, on prendra une valeur 
de 5,06 environ (repartition gaussienne) pour la variable K_seuil. 

La realisation de ces tests statistiques implique que Ton soit 
capable de propager et de recaler les variances associees aux vecteurs 
d'etat ErH des differents filtres predicteurs-estimateurs 40i, 4O2,.--, 40i,...,40N- 
15 La propagation et le recalage peuvent se derouler ainsi : 
A rinitialisation, on pose : 

COV^Errl,^ = [0] 

[0] etant la matrlce nulle. 
20 A la premiere propagation, par definition : 

COV^Errl,^ =^ E[Errl,^£rriJ \ 
ce qui s'ecrit en raison de la relation (1) : 

25 

COV^Erri^ ^E^F.JErrl,^ +u,'\{^,JErr^,^ +u^j\ 

\jt etant un bruit blanc (bruit d'etat). 
D'ou: 

30 COV_Erri^ ^ F^.COV _Errl,^J^^ 

F etant la matrice d'evolution du filtre de Kalman d'hybridation 3 et Qi la 
matrice de covariance des bruits d'etat du filtre de Kalman d'hybridation 3. 
Au premier recalage, par definition : 
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COV^Errl^ ^ E\Erri,^.Errln \ 
ce qui s'ecrit, en tenant compte de la relation (2) : 

5 

COV^Errl, =4^rr/,o +K,{z' --H,ErT;,,l(Err^,, +K,(r -H,Errl,j\ 
En developpant cette expression, on trouve : 

COV_Errl,, = ^[^rr/), Errl^J \^ K,e[z, ^'"'Ji^:/ ^ K,.H,E^rrl^, Errlj\H,^ JC,\„ 
D'oLl : 

16 COV^Etrl, =={l-K,JI,).COV_Errl^.{l-K,.Hj ^K,^[z' ■Z'^'ls:/ 

I 6tant la matrice identity. 

Le premier terme de Texpression du recalage de la matrice de 
covariance se calcule a partir de la matrice d'observation Hi des filtres 

20 predicteurs-estimateurs 40i, 4O2,.-., 40i,...,40N et de la matrice de gain Ki du 
filtre de Kalman d'hybridation 3. Le deuxieme terme se calcule au moyen des 
matrices de variance-covariance utilisees dans les calculs des moindres 
carres effectuSs pour la resolution des position, Vitesse et temps dans le 
rScepteur GNSS 2, lors des points de positionnement a N et (N-1) satellites. 

25 En efFet, lors de cette resolution, la methode des moindres carres evalue le 
degre de confiance sur les points resolus par I'intermediaire des matrices de 
variances covariances (matrices E[P(n-i)/i.P{n-i)/] pour les N points d (N-1) 
satellites et E[Ptot.Pfot^] pour le point a N satellites). 
Or: 

Car : 
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A/ 
Az' 



En developpant la premiere expression, on obtient : 



10 



20 



Les deux premiers termes sent connus. lis sent directement 
foumis par les calcuis des moindres carres lors de la resolution des differents 
points de position, vitesse et temps effectues par le recepteur GNSS 2. 

Les termes ^[i^jyr-i)/i-^J ®t ^fe^-P(^-i)/f]> traduisant I'inter- 
correlation entre le point de positionnement Ptot ^ N satellites et les points de 
positionnement P(N-i)/i a (N-1) satellites, peuvent etre evalues en reprenant 
('expression des moindres carres de chaque point. 

En efFet, on a : 



15 H, 



(N~i)/i etant la matrice pseudo-inverse utilisee dans la resolution position, 

Vitesse et temps faite lors du point de positionnement effectue a N-1 
satellites (absence du ieme satellite) : 

^(ViVz =(^(^-i)/f-^(iyr--i)/J^^ constmite a partir de la matrice 

qui est la matrice des cosinus directeurs liant les pseudo-distances d a 
la position resolue par la relation : d = II(2^-i)/rP(^-i)/i 
d etant le vecteur forme par les pseudo-distances. 
Ainsi : 



TT*T 

i-^ iot 



25 Or: 



et 



30 car la relation 
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entraTne 



De ce fait : 

En outre, on a I'egalite suivante : 

^L-^iN-O/i =^(^-i)/i-^(iyr-i)/i 

10 La matrice H^jf^iy^ne differe de la matrice H^^ que par la ieme 

ligne qui est nulle dans le cas de la matrice H^j^_^y^ et qui comporte les 
cosinus directeurs de la ligne a vue du ieme satellite dans le cas de la 
matrice H^,, En effectuant le produit de matrices Hl,JI^^_^)f^, les termes de 
la ieme colonne de la matrice H^^ sont multiplies par les termes nuls de la 

15 matrice ^(^_)/, . Ainsi, si les termes de la ieme colonne d'une matrice 
multipliee par la matrice ^(^y^-)// sont deja nuls (comme dans le cas de la 
matrice il n'y a pas de changement. Cela explique I'egalite ci- 

dessus. Par consequent : 

done : 

Finalement, nous avons la relation : 

25 e[z^JZ^'] = e[p^^.,^,,J^^^^^^^ 

qui montre que la matrice e[z\Z'^] peut etre evaluee a partir des matrices 
issues des calculs des differents points de position, vitesse et temps 
effectues par le recepteur GNSS 2. 
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Le premier recalage et la premiere propagation ne posent done 
pas de probleme. Les matrices d'evolution Fi et de gain Ki utilisees sont 
celles du filtre de Kalman d'liybridation 3 tandis que la matrice d'observation 
H est commune a tous les filtres predicteurs-estimateurs 40i, 402,---, 
6 40i,.-.,40n. 

Par recurrence, il est possible de montrer qu'il en est de meme 
pour les recalages et propagations suivants. 

Des qu'au moins un des tests statistiques est leve ou positif, il y a 
suspicion de mauvais fonctionnement de Tun des satellites visibles sur 

10 lesquels se base le recepteur GNSS 2 pour determiner position et vitesse du 
porteur. Ce franchissement est utilise pour declencher le circuit inhibiteur 5 
intercale entre la sortie du filtre de Kalman d'hybridation 3 et Tentree de 
recalage de la centrale inertielle 1, le satellite fournissant des donnees 
erronees ne sera reintegre que lorsque tous les tests statistiques ne seront 

15 plus leves, avec eventuellement un delai supplementaire de precaution. 

On remarque qui! est egalement possible d'estimer un rayon de 
protection sur la position hybride issue de la centrale inertielle 1 en utilisant la 
methode du maximum de separation. 

Le circuit 4 de detection de probleme satellite ne permet pas 

20 d'identifier le satellite fautif car Tinformation erronee provenant de ce satellite 
est prise en compte dans le point a N satellites visibles qui sert de reference. 

Sachant que Tun des satellites visibles utilises par le recepteur 
GNSS 2 emet des informations suspectes, il est interessant de pouvoir 
i'identifier pour le faire mettre a Tecart par le recepteur GNSS 2. 

25 La figure 4 donne un exemple de schema d'un systeme hybride 

INS/GNSS en boucle fermee equipe d'un detecteur de probleme satellite et 
d'un identificateur de satellite dSfaillant. 

Comma dans le cas de la figure 3, on retrouve une centrale 
inertielle INS 1, un recepteur GNSS 2, un filtre de Kalman d'hybridation 3 

30 operant sur les residus des erreurs entre la position, en coordonnees 
geographiques, donnee par la centrale inertielle INS 1 et celle, egalement en 
coordonnees geographiques, donnee par le recepteur GNSS 2 etfoumissant 
des informations de recalage a la centrale inertielle INS 1 , et un circuit 4 de 
detection de probleme de satellites analogue d celui de la figure 3 

35 commandant un circuit d'inhibition 5 Intercale entre la sortie du filtre de 
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Kalman d'hybridation 3 et une entree de recalage de la centrale inertielle INS 
1. 

En plus de ces elements apparaTt un circuit 6 identificateur de 
satellite defaillant operant a partir de differents points de position, en 
5 coordonnees geographiques, effectues par le recepteur GNSS 2 avec tous 
les satellites visibles moins un et avec tous les satellites vislbles moins deux, 
les deux satellites visibles ecartes etant a chaque fois differents. Ce circuit 6 
identificateur de satellite defaillant fonctionne en parallels du circuite 4 de 
detection de probleme satellite. II est active par le circuit 4 en cas de 
10 detection de probleme de satellite. II identifie le satellite defaillant pour le 
recepteur GNSS 2 qui ne le prend alors plus en compte pour faire le point de 
position et de vitesse qui est envoye au filtre de Kalman d'hybridation. Une 
fois le satellite defaillant ecarte, le circuit 6 identificateur de satellite desinhibe 
le circuit d'inhibition 5 et la plate-forme virtuelle PDV de la centrale inertielle 
15 INS 1 est d nouveau corrigee. 

Le circuit 6 identificateur de satellite defaillant se base sur des 
tests en prenant comme references les differents points de position possibles 
avec N-1 satellites qui sent compares a des points de position a N-2 
satellites issus de ces points ^ N-1 . Ces tests consistent a : 
20 - evaluer, pour chaque selection possible de N-1 satellites parmi 

les N observables, les ecarts de position, en coordonnees.,, 
geographiques, constates entre le point de position fait par le 
recepteur GNSS 2 avec Tensemble des N-1 satellites de la 
selection et les diflerents points de position possibles a N-2 
25 satellites que peut faire le recepteur GNSS 2 en ecartant un 

satellite supplementaire de la selection, 

soumettre ces ecarts a un banc de filtres predicteurs- 
estimateurs pour evaluer Terreur induite conjointement par deux > 
satellites, 

30 - comparer les etats de ce deuxieme banc de filtres predicteurs- 

estimateurs avec les variances qui leurs sont associees, 
identifier la famille de filtres ne levant pas leur test statistique et 
en deduire le satellite en panne, 

indiquer au recepteur GNSS le satellite corrompu pour le retlrer 
35 de I'ensemble des satellites visibles utilises pour resoudre le 
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point de position (et de vitesse) a N satellites cx)mmunlque au 
filtre de Kalman 

desinhiber les corrections fournies par ie filtre de Kalman a la 
centrale a Inertie une fois Ie satellite defecteux retire du point du 
6 recepteur GNSS et Ie filtre reconfigure, 

En effet, ce n'est que lorsque Ie satellite lautif est evince de la 
selection de N-1 satellites et des selections de N-2 satellites qui en dScoulent 
que les tests statistiques sur les etats des filtres predicteurs-estimateurs ne 
se dedencheront pas (tests non leves). 
10 Comme nnontre a la figure 5, Ie circuit 6 identificateur de satellite 

defeillant comporte un banc de N.(N-1)/2 filtres predicteurs-estimateurs 61 g 
(1:^j<j^N, i et j designent les satellites non observes lors de la resolution du 
point a N-2 fourni au filtre predicteur-estimateur) traitant toutes les 
possibilites d*ecarts entre un point de position, en coordonnees 
15 geographiques, a N--1 satellites visibles et un point de position, egalement en 
coordonnees geographiques, a N-2 satellites visibles, Ie satellite exclu de la 
selection a N-1 satellite I'etant egalement de la selection a N-2 satellites. Un 
circuit de test 62ij associe a cheque filtre predicteur-estimateur 61 y du banc 
teste les etats modelises dans Ie filtre predicteur-estimateur par rapport ^ 
20 leurs variances. Un circuit de traitement 63 extrait des tests fournis par les 
..circuits de tests 62ij Tidentite du satellite fautif. 

Chacun des filtres predicteurs-estimateurs 61 y du banc de filtre 
dedie k Tidentification du satellite en panne a la meme configuration que les 
filtres predicteurs-estimateurs 40i du banc de filtres dedlSs a la detection de 
25 defaillance d'un satellite avec les memes matrices de gain K, d'evolution F et 
d'observation H, et regoit, comme mesure, I'ecart fourni par un circuit 
soustracteur 60ij entre la position, en coordonnees geographiques (latitude, 
> longitude et altitude), resultant d'un point de positionnement P(;sr-i)/f effectue 
par Ie recepteur de positionnement par satellites GNSS 2 en tenant compte 
30 des N satellites visibles moins un, Ie i^"^® et la position en coordonnees 
geographiques resultant d'un point de positionnement P{N-2)/ij effectue par Ie 
recepteur de positionnement par satellites GNSS 2 en ecartant les 
informations du satellite deja exclu, Ie i^*"® et d'un autre, Ie j^"^®. 

Les calculs des variances associees necessaires aux circuits de 
35 tests 62ij pour comparer les etats par rapport § leurs variances sent 
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exactement les memes que ceux decrits pour les circuits de test 41 1 associes 
aux filtres predicteurs-estimateurs 40| du premier banc et ne seront pas 
repris ici. Seule {'observation est differente puisqu'il s'agit ici de difference 
entre des points resolus avec (N-1) satellites visibles et des points resolus 
5 avec (N-2) satellites visibles. 

Le circuit de traitennent 63 compare les tests des N differentes 
families, ou le \^"^ satellite a ete enleve pour la resolution du point de position 
a N-1 et des points de position a N-2 satellites (l^i^N), puis identifie le 
satellite defectueux par le fait que seuls les filtres predicteurs-estimateurs 

10 d'une famille, ceile ne prenant jamais en compte le satellite defectueux n'a 
aucun test statistique leve. En effet, outes les autres families de filtres 
predicteurs-estimateurs comparant les points de position a N-lou le satellite 
defaillant est present avec des points de position a N-2 satellites ont au 
moins un test statistique leve. Ce circuit de traitement 63 permet d'eviter 

15 rutilisation du satellite corrompu dans la resolution du point GNSS foumi au 
systeme hybride. 

Pour faciliter la comprehension, les fonctions realisees dans un 
dispositif de surveillance de I'integrite d'un systeme hybride INS/GNSS ont 
ete illustrees sous forme de blocs separes mais il est bien evident qu'elles 

20 peuvent etre remplies par un meme calculateur a logique programme, par 
exemple le calculateur de gestion du vol si Je porteur du systeme hybride de 
positionnement est un aeronef. 



wo 2005/088337 



PCT/EP2005/050390 



24 

REVENDICATIONS 

1 . Dispositif de surveillance de Tintegrite d'un systeme hybride 
constitue d'une centrale inertielle INS (1), d'un recepteur de positionnement 
par satellites GNSS (2) operant a partir d'une constellation de N satellites 
5 vislbles, et d'un filtre de Kalman d'hybridation (3) ayant un vecteur d'etats 
correspondant aux erreurs du systeme hybride, en particulier ies erreurs de 
biais et de derive residuelles de la centrale inertielle INS (1), observant Ies 
ecarts entre Ies points de positionnement et de Vitesse fournis, en 
coordonnees geographiques, par la centrale inertielle INS (1) et par le 

10 recepteur GNSS (2), ayant une matrice d'evolution F modelisant revolution 
des erreurs du systeme hybride, une matrice d'observation H modelisant Ies 
relations entre le vecteur d'etats et Ies ecarts observes entre ies positions et 
de vitesses delivrees par la centrale inertielle INS (1) et le recepteur GNSS 
(2), et un gain K minimisant la covariance de I'erreur faite sur I'estimation a 

15 posteriori du vecteur d'etats du filtre de Kalman et en particulier des erreurs 
residuelles de la centrale inertielle INS (1), et delivrant une estimee a 
posteriori des erreurs du systeme hybride qui sert a recaler la centrale 
inertielle INS (1), caracterise en ce que le recepteur GNSS (2) delivre en plus 
d'un point de position effectue a partir des N satellites visibles qu'il a en vue, 

20 des points de position P(N-i)/ii i ^ [1>- -N] resolus avec N'-l satellites visibles 
deduits de la constellation des N satellites visibles en la privant a chaque fois 
d'un satellite different et en ce qu'il comporte un circuit (4) d^tecteur de 
probleme satellite comportant un banc de N filtres predicteurs-estimateurs 
(40i) de Terreur induite par le satellite qui a ete dte lors de la resolution d'un 

25 point de position a N-1 satellites, ayant le gain K et la matrice d'evolution F 
du filtre de l^lman d'hybridation (3), observant chacun I'ecart entre le point 
de position, en coordonnees geographiques, delivre par le recepteur GNSS 
(2) en observant Ies N ss^tellites visibles et Tun des points de position P(N-iyi, 
egalement en coordonnees geographiques, delivres par le recepteur GNSS 

30 (2) en observant N-1 satellites visibles et des circuits de test (410 comparant 
Ies etats des filtres predicteurs-estimateurs (40[) a leurs variances et 
detectant une panne satellite lorsque le test est positif, I'ecart trouve etant 
superieur a un seuil de detection. 
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2. Dispositif selon la revendication 1 , caracterise en ce que les 
seuils de detection sont des seuils statistiques qui tiennent compte de la 
covariance associee au type d'erreur de positionnement considere. 

5 3. Dispositif selon la revendication 1 , caracterise en ce que les 

seuils de detection sont des seuils statistiques qui tiennent compte de la 
covariance associee au type d'erreur de positionnement considere et qui 
sont fonctlon du taux de fausse alarme acceptable pour le test. 

10 4. Dispositif selon la revendication 1, caracterise en ce qu'il 

comporte un circuit (5) d'inhibition de recalage intercale entre la sortie du 
filtre de Kalman d'hybridation (3) et une entree de recalage de la centrale 
inertielle INS (1), et active par le circuit (4) detecteur de pnobleme satellite. 

15 5. Dispositif selon la revendication 1, caracterise en ce que les 

flltres predicteurs-^stimateurs (40i) du circuit (4) detecteur de probleme 
satellite ont tous la m§me matrice d'observation. 

6. Dispositif selon la revendication 1 , caracterise en ce que le 

20 recepteur GNSS (2) delivre des points de position P(N-i)/i i e [1,-N] et P(N-2)/ij 
(1^i<j<N), en coordonnees geographiques, r6solus a partir de N-1 et N-2 
satellites deduits des N satellites visibles en retirant a chaque fois un satellite 
visible different, le i^""® pour le point P(N-i)/i, et en retirant en plus un autre 
satellite panmi les N -1 restant, le j^""® pour le point P(N-2)/ia, et en ce qu'il 

25 comporte un circuit (6) identificateur de satellite dSfaillant comportant un 
banc de Nx(N-1}/2 flltres predicteurs-estimateurs (61 ij) estimateurde I'erreur 
induite conjointement par deux satellites parmi les N observables ayant le 
gain et la matrice d'evolution F du filtre de kalman d'hybridation (3), 
observant chacun Tecart entre un point de position (P(N-i)/i), en coordonnees 

30 geographiques, delivre par le recepteur GNSS (2) a partir d'une constellation 
specifique de N-1 satellites visibles et Tun des points de position P(N-2)/ij 
delivres par le recepteur GNSS (2) a partir d'une constellation de (N-2) 
satellites visibles deduite de la constellation specifique de (N-1) satellites 
visibles privee de Tun de ses satellites, le les flltres predicteurs- 

35 estimateurs pouvant etre regroupes par families de N-2 elements en fonctlon 
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de la constellation specifique de N-1 satellites prise en cxjnnpte, un banc de 
circuits de test (62jj) comparant les etats des filtres predicteurs-estimateurs 
(61i,j) a leurs variances et detectant une anomalie lorsque Tecart trouve est 
superieur a un seuil de detection, et un circuit de traitement des resultats des 
5 tests (63) centralisant les tests leves Identifiant, en cas d'anomalie detectee, 
un satellite fautif comme etant le satellite exclu d*un point de position resolu 
avec N-1 satellites dont la famille de filtres predicteurs-estimateurs est la 
seule a n'avoir aucun de ses elements detectant une anonrtalie. 

10 7. Dispositif selon la revendication 6, caracterise en ce que les 

seuils de detection des circuits de test (62jj) du circuit (6) identificateur de 
satellite defaillant sent des seuils statistiques tenant compte de la covariance 
associee au type d'erreur de positionnement considere. 

15 8. Dispositif selon la revendication 7, caracterise en ce que les 

seuils de detection des circuits de test (62ij) du circuit (6) identificateur de 
satellite defaillant sent des seuils statistiques qui tiennent compte de la 
covariance associee au type d'erreur de positionnement considere et qui 
sont fonction du taux de fausse alarme acceptable pour le test. 

20 

9. Dispositif selon la revendication 6, caracterise en ce que les 
filtres predicteurs-estimateurs (61 jj) du circuit (6) identificateur de satellite 
defaillant ont tous la memo matrice d'observation. 

25 10. Dispositif selon la revendication 6, caracterise en ce que les 

flltre predicteurs-estimateurs (40i, 61 jj) du circuit (4) detecteur de probleme 
satellite et du circuit (6) identificateur de satellites delaillant ont tous la meme 
matrice d'observation. 
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